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DUPLICATE 

1 

PATHFINDING SYSTEM 
TECHNICAL FIELD 

5 The invention relates to a method and system for determining a path along a plurality of points in a 
representation of a real or virtual world. In particular, but not exclusively, the invention relates to a 
method and system for determining a path in which for each node of the path a constraint is imposed 
on the entry and/or exit angle made by each LoS connection to adjacent nodes along the path. 

10 INTRODUCTION 

As more and more systems are becoming available for determining an optimal path between a set of 
points it is becoming more and more important for the paths which are generated to be user friendly as 
well as optimal in terms of efficiency. System may provide representations of both virtual environments 
15 (for example, where such systems can be implemented as games or other virtual world environments) 
or representations of real environments (for example, where such systems can comprise navigational 
aids for both sea and land environments), 

Systems in which 3-dimensional virtual reality environments (virtual worlds) are defined and created 
20 are becoming increasingly prevalent in the current technological age. Such computer systems are 
applicable in numerous commercial applications, such as for online tourist sites, fantasy worlds, 
gaming, architectural walk-throughs, estate agency (virtual tours of houses for sale), and many others. 
Typically, a virtual world might be defined by multiple x.y.z, co-ordinate sets which together map out 
an environment in three dimensions (x, y, and z axes). Objects and walls (or other items which exist 
25 within the virtual world), which a user navigating through the virtual world is not allowed to walk 
through, can be implemented by what is termed a collisionable mesh. The collisionable mesh may 
therefore comprise a further set of three dimensional co-ordinates defining shapes within the virtual 
world which the user must navigate around. 

30 Navigation is required within virtual worlds for any entity passing through that world, such as a 
computer generated person, vehicle or gaming character. This is typically under the control of an 
external human user. Traditionally, many commercial implementations of virtual environments have 
been built on the basis of the self-navigation techniques inherited from games engines, where 
exploration of all areas of an unknown virtual world is expected, and also a high degree of user 

35 competency is assumed. However, as the application of virtual worlds spreads into other commercial 
areas, it is important that, the functionality of navigation evolves to suit the competency and 
requirements of a whole new wider group of users. Such users may not be as proficient in the 
navigation around virtual worlds, and furthermore may be disinclined to spend large amounts of time 
familiarising themselves with the environment. They are likely to become disorientated or bored much 

40 more quickly, or even miss important content entirely, unless the user experience is significantly 
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improved. 

In our day-to-day lives, humans typically employ various techniques to help us with our navigation 
when moving from place to place. We retain an idea of our location and orientation using fixed points 
5 of reference (landmarks), measures of distance travelled and changes in direction so as to prevent 
ourselves becoming disorientated. Such techniques may not be available to the novel user in a virtual 
world which they are unfamiliar, particularly if teleporting (e.g. instantaneously transferring between 
two different points in the world) is applied, as is the case in many gaming environments. 
Consequently, it is advantageous to provide an automated pathfinding system for the inexperienced 
1 0 user to help them navigate them through the virtual world, allowing them to overcome the problems of 
lack of familiarity and any frustrations with the traditional interface of self-navigation. Consequently, 
many systems have been developed which automatically calculate the best path through a virtual 
world, for example to find the shortest path to view a particular object or to pass through a room. 

15 However, even when pathfinding is automated and a guided path is provided for a user to 
automatically navigate along, a user may become confused when many changes of direction occur. 
These may be actual changes in direction of the guided path, or changes in direction of the field of 
view of the user as they are navigating along the guided path. 

20 The result in both cases is for the user to become more disorientated, and to lose their sense of 
direction. Accordingly, it is useful if the guided path along which a user is automatically navigated can 
be constrained so that the if, when navigating along a path automatically generated from A to B, the 
path changes direction several times. As the user becomes more familiar, they may wish to follow a 
more winding path, as they will still maintain their sense of orientation. Accordingly, it is useful if the 

25 angle differential between the mesh points used to generate the path can be constrained according to 
a user's personal preference. 

Nodal path generation is well known, for example, "Smart Moves: Intelligent Pathfinding" by Bryan 
Stout, published in Game Developer, October 1996, and also available online at 
30 http://www.qamasutra.com/features/19970801/pathfindinq.htm provides an broad introduction to 
various pathfinding techniques which can be used in virtual worlds. In particular, it discusses and 
compares breadth-first pathfinding (including Dijkstra's Algorithm), depth-first and best-first pathfinding 
techniques. 

35 Ail pathfinding algorithms work by expanding possible paths, one node at a time until a path from the 
start node to the destination node is found. The order in which the nodes are attempted is critical to 
the speed and quality (e.g. length) of the final path that is found. In a breadth-first techniques, the 
algorithm searches firstly through all a nodes' immediate neighbours, and then moving onto the 
neighbours of those neighbouring nodes. In contrast, in depth-first techniques, the algorithm searches 

40 for a path recursively using a child node each time until reaching a predetermined depth, at which 
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point it retraces it's steps and tries other child nodes. A best-first search chooses paths preferentially 
on the basis of an estimate of the shortest remaining distance to the goal. However, Stout does not 
discuss the problems associated with constraining the angle differential between nodes. 
The article entitled "Middleware Solutions for Artificial Intelligence in Computer Games" (Chapter 3 - 
5 Al Techniques) by Jan-Harald Fredriksen of the Norwegian University of Science and Technology, 
located at http://wwwJdi.ntnu.no/qruDPer/su/fordvpninasprosiekt-2003/fordvpninq2003-Jan-Harald-- 
Fredriksen.pdf is also concerned with pathfinding techniques in virtual worlds, and the use of the A* 
algorithm. This document considers the use of cost constraints for different terrains to be taken into 
account when calculating a path through the virtual world, and the use of hierarchical pathfinding 

10 (finding a broad overall route before computing the detailed portions) and portals (which split regions 
of the virtual world into smaller parts) for improved computation performance. . However, Fredriksen 
does not either consider applying constraints to the path generation such as angle-differential. 
Fredriksen describes two alternative versions for the underlying structure of the virtual world on which 
the pathfinding in this document is based. The first is referred to as the POV (points of visibility) 

15 approach, in which a plurality of nodes (called waypoints) are introduced into the virtual world, and 
which the path is found on the basis of line-of-sight links between the nodes. The second approach is 
the use of a navigation mesh in which a plurality of convex polygons cover the surface of the world, 
and in this case the pathfinding algorithm considers each polygon to be a node and calculates a path 
through the virtual world accordingly. 

20 

SUMMARY OF THE INVENTION 

According to a first aspect of the present invention, there is provided a method of determining a path 
along some of a plurality of points in a representation of an environment, the representation 

25 comprising a plurality of initially defined points, and obstructions through which the path cannot pass, 
the method comprising: defining a plurality of additional points by repeating the following steps: 
defining a new point located between a first existing point and a second existing point, wherein a first 
line between the first point and the new point and a second line between the new point and the second 
point do not pass through any of the obstructions; and calculating the path based on any combination 

30 of new and/or initially defined points, wherein the angle of deviation of the first line to a line between 
the first and second points is constrained. 

The constraint may be imposed by assigning a varying angle of deviation cost value in dependence on 
the angle to which the first line deviates from the second line. 

35 

The angle of deviation cost value may be zero when said angle is 180 degrees, and said angle of 
deviation cost value is a maximum when said angle is 360 degrees. 

Alternatively, an alternative system of reference may be used to define the angle of deviation, in which 
40 case the cost value may be higher when the angle is 180 degrees, and lower when it is zero degrees. 
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The environment may comprise a virtual world. 

The representation may model a real world navigable environment. The navigable environment may 
comprise a sea-based environment and/or a land-based environment. 

5 

The angle of deviation may be constrained to a predetermined range. The range of the angle of 
deviation may be determined as a function of a range of angles within which the first line approaches 
the new point from the first point, and a predetermine angle of deviation. 

10 The method may be performed to create the content of the virtual environment and/or the method may 
be performed after the content creation of the virtual environment to dynamically determine the path. 

Advantageously, if the nodal subdivision process of the invention is performed at least partially prior to 
generating a spline path from a start node to a destination node, the processing required to generate 
15 the spline path is reduced. For example, if a node is static within the virtual environment, sub- 
divisions of the nodal space around that node may be advantageously performed as a preprocessing 
stage prior to generating a path. However, if the virtual environment is populated with may nodes 
which are dynamically changing such a preprocessing stage may provide a smaller performance gain. 

20 The path determined may have a dynamically changing destination node. The path determined may 
define a field of view of said virtual environment. 

A second aspect of the invention seeks to provide a system for determining a path along some of a 
plurality of points in a representation of an environment, the representation comprising a plurality of 

25 initially defined points, and obstructions through which the path cannot pass, the system comprising: 
processing means to define a plurality of additional points by repeatedly defining a new point located 
between a first existing point and a second existing point, wherein a first line between the first point 
and the new point and a second line between the new point and the second point do not pass through 
any of the obstructions; and processing means to calculate the path based on any combination of new 

30 and/or initially defined points, wherein the angle of deviation of the first line to a line between the first 
and second points is constrained. 

The system may further comprise means to enable a user to be automatically navigated along said 
path. 

35 

The system may comprise means to enable a user to select the degree to which said path is wiggly. 
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A third aspect of the invention provides a user interface for a system according to the second aspect, 
wherein the user interface is arranged to provide said means to enable the user to select said degree 
to which said path is wiggly. 
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The user interface may be provided to implement content creation of the virtual world and/or 
implement a user profile for said virtual environment. 

5 A fourth aspect of the invention provides a storage medium carrying computer readable code 
representing instructions for causing one or more processors to perform the method of the first aspect 
when the instructions are executed by the processor or processors. 

A fifth aspect of the invention provides a computer program comprising instructions for causing one or 
10 more processors to perform the method according to the method of the first aspect when the 
instructions are executed by the processor or processors. 

A sixth aspect of the invention provides a computer data signal embodied in a carrier wave and 
representing instructions for causing one or more processors to perform the method according to any 
15 of the first aspects when the instructions are executed by the processor or processors. 

A seventh aspect of the invention provides a storage medium carrying computer readable code 
representing instructions for causing one or more processors to operate as the system according to 
the second aspect when the instructions are executed by the processor or processors. 

20 

An eighth aspect of the invention provides a computer program comprising instructions for causing 
one or more processors to operate as the system according to the second aspect of the invention 
when the instructions are executed by the processor or processors. 

25 A ninth computer data signal embodied in a carrier wave and representing instructions for causing one 
or more processors to operate as the system according to the second aspect of the invention when 
the instructions are executed by the processor or processors. 

This invention is applicable to any type of virtual world, which might include for example fantasy worlds 
30 or worlds based upon a real environment such as a historic building or design for a future building, or 
a house that is for sale, and in which the obstructions might comprise walls or other obstacles, for 
example. The representation in the sense used above is likely to refer to stored digital data that 
represents such a world. Alternatively, the virtual environment may provide a representation of the 
real world. 

35 

The new point may be located on the mid point of the link. Step (a) may further comprise deleting the 
new point if it is less than a predefined distance from another of the points, and the predefined 
distance may vary in different regions of the virtual world. The method may further comprise identifying 
a link as not being suitable for providing the location for a new point if said link intersects another one 
40 of said links which is shorter. A new point may be deleted if it does not have line of sight to each of a 
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pair of points which do not have line of sight to each other and/or may be deleted if it does not form 
part of a path between two other nodes that is shorter than the shortest path which would exist 
between said two points without said new point. 

5 Advantageously, the arrangements of the invention employ a technique which allows a content 
provider to define some initial points for navigation in a virtual world, allowing the content provider to 
influence the routes taken and the items of interest that can be visited by a user. The system then 
automatically multiplies the number of points in a manner which will improve the user's experience 
along the subsequently generated path through the environment compared with only a limited set of 
10 originally defined navigation points. 

In comparison with previously known systems in which a path through a virtual world is not 
constrained to specific navigation points, the embodiments of the invention provide improved 
processing during the actual pathfinding procedure. This is because no collision detection (ensuring 
15 the path avoids obstacles, etc) is required during pathfinding in the embodiments since all the new 
navigable nodes and links have been added on line of sight principles, and therefore by definition 
already avoid all the potential obstacles. 

Additionally, these embodiments provide advantages over previous known systems such as the AA 
20 Routefinder which are necessarily limited to finding routes along specified predefined roads, etc. In 
contrast, in the embodiments, the user is able to navigate within all areas of the virtual world. 

The aspects of the invention are as set out in the accompanying claims, together with dependent 
claims representing preferred features of the invention. The preferred features of the invention may 
25 be suitably adapted to be combined with each other and/or with any of the aspects of the invention as 
is apparent to those skilled in the art. 

BRIEF DESCRIPTION OF THE DRAWINGS 

30 For a better understanding of the present invention, specific embodiments will now be described, by 
way of example, with reference to the accompanying drawings, in which: 

Figure 1 shows a schematic of a navigation system according to an embodiment of the invention; 

35 Figure 2 shows a diagrammatic representation of a virtual world environment; 

Figures 3 to 12 show further diagrammatic representations of the virtual world environment of Figure 
2; and 

40 Figure 13 shows a flow chart of the method for processing points within a virtual world according to 



one embodiment of the invention; 

Figures 14A to 14C show how an angle differential weighting influences the connection angle between 
two nodes in a virtual world according to one embodiment of the invention; 

5 

Figures 15A and 15B show two wiggly paths with differing degrees of waviness. 

Figure 16A shows a navigational node with a valid LoS Angle range constraint; 

10 Figure 16B shows how range of LoS angles may implement a constraint on the connection angel 
between two nodes according to another embodiment of the invention; and 

Figure 17 shows how a range of LoS angles may implement a constraint on the angle of entry and 
angle of exit of an automatically generated path passing through a node according to another 
1 5 embodiment of the invention. 

DETAILED DESCRIPTION OF EMBODIMENTS OF THE INVENTION 

The best mode of the invention currently contemplated by the inventors will now be described with 
20 reference to the accompanying drawings. 

Figure 1 illustrates a system 1 for creating, and allowing a user to navigate within, a virtual world. The 
system comprises a server computer 2, accessible to a content provider (a human user who will input 
the specification for the virtual world) via terminal 3, and accessible to a user (desiring to view and 
25 navigate through the virtual world) via another terminal 4. In this particular embodiment, access from 
both terminals to the server 2 is through a general network 5, such as for example the internet, 
although it is understood that the illustrated computer arrangement may be replaced by any suitable 
alternative which allows a content provider to design and implement a virtual world, which a user can 
subsequently access and interact with. 

30 

A schematic of a simple virtual world environment is shown in Figure 2. This represents a room 20, 
including walls 21, doors 22, and various obstacles 23, 24 and 25 within the room. When specifying 
the design of this virtual world 20, the content provider inputs data in the form of co-ordinates 
representing the shape of the environment into the server 2 via terminal 3. The data might include co- 
35 ordinates representing a collisionable mesh defining the obstacles 23, 24, and 25 through which a 
navigating user is not allowed to pass. 



40 



Feature Nodes 

The content provider is able to define features of interest within the room that a user may wish to view. 
For example, if the virtual world represents a tour through a historic building, it may be desirable to 
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insert features such as statues, furniture, paintings and information boards. These may be 
represented by objects within the room, for example statue object 26, painting 27, and information 
boards (obstacle 25). 

5 In order that these features may be visited by a user, the content provider defines feature nodes 28A, 
28B and 28C (shown in Figure 3) associated with the features, which the user can view or interact 
with. A feature node is therefore essentially a point in the virtual world, linked either to an object or to 
the collisionable mesh, and in the embodiment has the following data set: 



Node ID 

Feature Group ID 

Object ID of the linked mesh / object 
XYZ of object pivot point data 
Sphere of influence settings 
Display settings 

10 

Node ID - an unique identifier for the node (e.g. text string "monet_painting_01" or numerical identifier 
"00563") 

15 Feature Group ID - an identifier for the type of feature associated with the node, for example all 
paintings may be in a first Feature Group identified as "paintings", whilst information boards might be a 
second Feature Group "information_points". The choice of groupings is highly dependent on the 
content provider and the type of features they wish to distinguish within the virtual world. 

20 Object ID of linked mesh / object - this is the identifier for the object or collisionable mesh associated 
with the feature node, and may be the same as the node ID (e.g. "monet_painting J31 ") 
XYZ of Object Pivot Point Data - these are the co-ordinates giving the location of the feature node 
(and may be obtained by extraction from properties of the object / mesh with which the feature node is 
associated) 

25 

Sphere of influence settings - these define (for a 3D world) a three dimensional sphere (for example, 
illustrated as circle 31 in Figure 3) surrounding the feature node, and are used during the calculation of 
navigation paths through the virtual world 

Display settings - these are some of the settings to be used for text / images associated with the 
30 feature 

Navigational Nodes 

The content provider also initially defines a plurality of navigational nodes (29A, 29B, 29C, etc) within 
the virtual world, as shown in Figure 3. Essentially, these provide a simple matrix of navigational 
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points which the automated path generation algorithm can use to plot a route through the 
environment Associated with each navigational node is the following data set: 



Node ID 

Node Level ID (optional) 
XYZ position 
LoS data 

LoS constraint settings (optional) 
FoV constraint settings (optional) 
Orientation constraint settings (optional) 



5 

Node ID - a unique identifier for the node 

Node Level ID - this is an identifier which allows a level for the node to be defined, effectively 
grouping the nodes into different subsets, and used during the path finding process to split the virtual 

10 world into different regions for processing efficiency. For example, two different rooms in the virtual 
world could be represented by different regions of nodes, with the doorway between them comprising 
a switch node. For processing efficiency, a path can initially be calculated based on only the nodes of 
one of the rooms (thus saving erroneously calculating at this stage paths which enter the second 
room, and only later allowing the pathfinding calculation to extend to the second room via the switch 

15 node). Additionally it is possible that the different sub-sets could cover overlapping regions (for 
example a first level of nodes might provide coarse coverage of a large area while different levels 
might provide finer coverage of the same area or subsets of that area). 

XYZ position- these are the x, y, z co-ordinates giving the location of the navigational node 
20 LoS data - this data field will be empty initially, but is later used to contain a list of all nodes which the 
present node has Line of Sight (LoS) to, i.e. all the nodes that it is able to link to (see later for further 
details) 

LoS constraint settings - the content producer may choose to manually define an angular LoS 
constraint (e.g. an angle range, in which the node is only allowed to search for nodes to link to if they 
25 fall within that viewing angle, see later for more details) 

FoV constraint settings - the content producer may choose to define angular constraints for the Field 
of View (FoV) which will constrain the range of images allowed to be displayed to a user at that node 
(e.g. for node 29F, the FoV may be constrained in the angular direction towards statue object 28A to 
30 ensure that the user sees the object) 

Orientation constraint settings - for some navigational nodes, the content producer may choose to 
constrain the allowed orientation of the user as they approach the node, by defining orientation 
constraint settings this forces the calculated path to approach the node from a particular direction. 



10 



The content provider is thus able, through the use of navigational nodes, to define key positions within 
the virtual world from which the potential user is able to best experience the features of interest within 
the environment. The content provider can define the exact position, direction of approach (orientation 
5 settings), and viewing angle (FoV constraint settings) so as to increase the quality of the user's 
experience of the features of interest, compared with other systems which are completely automated. 

Processing 

The subsequent processing is explained with reference to the flow diagram in Figure 13. After node 
10 data has been input to the system (step 40), a node matrix is automatically created for the virtual world 
(step 41). This identifies for each navigational node all the other navigational nodes it is able to link to. 
Node links are calculated following basic rules of LoS (line of sight) for two nodes. This takes into 
account the collisionable mesh and any other objects deemed to crop the LoS of the nodes (i.e. no 
links are allowed to pass through obstructions because a path between nodes cannot pass through 
15 these). Figure 4 illustrates all possible LoS links for navigational nodes in the virtual world 20 (i.e. the 
lines linking nodes 29A, 29B, etc). For example, Node 29A has direct line of sight to both nodes 29B 
and 29F, but not to 29C because this would pass through the obstacle 23. A node matrix for virtual 
world 20 of Figure 4 is represented in tabular form below: 



Node 


Links to other nodes 


29A 


29B, 29F 


29B 


29A, 29C, 29D, 29E 


29C 


29B, 29D, 29F 


29D 


29B, 29C, 29E 


29E 


29B, 29D, 29F, 29G 


29F 


29A, 29C, 29E 


29G 


29E 



20 

At this stage each navigational node's data set is provided with LoS data on all its visible partners, 
including their XYZ position. Any navigational node which does not have line of sight to any other 
navigational nodes is deemed invalid and may be deleted from the system. 

25 if the content provider had specified any LoS constraints for particular navigational nodes, then this 
would crop the angle it is allowed to search for node links. This is controlled using "LoS constraint 
settings" for the node, comprising degree values which slice the otherwise allowed 360 degree LoS. In 
this case, the node matrix above would differ as some of the links shown there would not be allowed. 
This functionality allows the content provider to create channels of nodes that ignore other nodes 

30 around them, and to produce breaks in the node matrix where nodes are not desired. This can 
improve the user experience because in this manner the content provider can influence the routes 
taken by a user within the virtual world. 
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The next stages of processing will add in additional nodes on the basis of the LoS links already 
defined. However, before that occurs, the system checks all the links (step 42) to decide which links 
will / will not be used as a base for the new nodes. In particular, the system looks for any crossed links 
5 (such as the 29B-29E link which crosses the 29C-29D link), and marks the longest of the crossed links 
as not being available for use as a base for the new nodes. In this embodiment a data flag is 
associated with the link (in either the node matrix or the individual nodes' LoS link data) to indicate that 
this link is "not to be subdivided". The affected link is shown as a dotted line in Figure 5. 

1 0 The next stage of processing involves the automatic creation of a more dense matrix of nodes (step 
43). This is achieved by subdividing the LoS links between the existing navigational nodes so as to 
add new navigational nodes (also referred to as subdivided nodes) at each midpoint (step 44). Figure 
6 shows these subdivided nodes (30A, 30B, 30C,... etc). As more and more new nodes are added 
during each cycle through step 43, the density of nodes increases, up to a maximum allowed node 

15 density. This density may be predefined in advance by the content provider, for example by specifying 
a minimum allowed distance from a node to it's nearest neighbour. After each new node is added, the 
system checks whether the new node meets the density criteria (step 45). If it falls outside the allowed 
density criteria, the new node is deleted (step 46). Otherwise, the node is kept. Once every LoS link 
has been examined for subdivision (step 47), the system checks whether any new nodes were added 

20 during the last pass (step 48). If no new nodes were created during a pass, the system terminates 
(step 49). 

For each pass, after the new nodes have been added, the LoS data for every node (both the 
navigational nodes and each newly created subdivided node) is updated to take account of all the 
25 multiple new possible LoS links (step 50). Figure 7 illustrates the newly created dense matrix with 
many more possible LoS links between the nodes. 

The system now checks which of the newly added nodes are valid (step 51). A node is defined as 
valid if it links any two other nodes which do not otherwise have line of sight to each other. This is 

30 illustrated for node 30A in Figure 8. In this drawing, for clarity, the only nodes and links illustrated are 
node 30A and the seven other nodes it links to. It can clearly be seen that node 30A acts as a bridge 
for many different pairs of nodes (i.e. it forms a connection between two nodes which do not have LoS 
to each other), such as between nodes 29B and 30F. Therefore node 30A is valid, and in fact only 
requires that it is connected to one pair of nodes which do not have LoS, to be defined as a valid 

35 node. Any invalid nodes are deleted. 

Figure 9 shows the same procedure for node 30B. Node 30B is defined as valid. However at this 
stage, any of 30Bs links which do not assist in bridging between two nodes are deleted. This is the 
case for the link between node 30B and 29C. Since node 29C already has line of sight links to all the 
40 nodes shown on Figure 9 (and reciprocally node 30B also has line of sight to all the nodes linked to 
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29C), therefore link 30B-29C cannot help to bridge between any pair of nodes that do not have line of 
sight to each other, and the link 30B-29C is deleted. 

Link 30B-30C would also appear from Figure 9 to be redundant, because node 30C already has line of 
5 sight to all the nodes in Figure 9. However, link 30B-30C is actually valid because it bridges, for 
example, nodes 30B and 30A (which do not have line of sight to each other) which can be seen from 
Figure 7, and therefore link 30B-30C would not be deleted. 

Validity checks are carried out in this manner for all new nodes, and two others (30E and 30H) are 
10 shown, in Figures 10 and 11 respectively. 

After the validity checks have been performed on the new nodes, the system again checks for any 
crossed links (step 52). These are the links which are not to be used in any subsequent cycles of 
subdivision. The links are identified as before, by looking for links which cross each other and flagging 
15 the longest ones as "not to be subdivided". This has been performed for all the links, and the resulting 
link matrix is illustrated in Figure 12 (where dotted lines illustrate those links which are not to be used 
in the future for subdivisions to add more nodes). 

Thus one cycle of subdivision has been completed, and even after this, the number of nodes has more 
20 than doubled, and the connectivity between the nodes has greatly increased. For example node 29D 
previously only had links to 29B, 29C and 29E, but is now additionally linked to 30B, 30C, 30E and 
30F. 

Further cycles of subdivision (step 43) may be repeated, until the system has created a suitably dense 
25 matrix of nodes which map out the non-coliisionable environment in the virtual world. Advantageously, 
during the subsequent pathfinding calculation, there is no need to calculate collision data in real time 
because the matrix nodes are all constrained to navigable areas. In addition, with the higher density of 
nodes in the environment, the system can generate far more efficient paths than with the originally 
defined node matrix, and which enhance the user experience by giving a much smoother path through 
30 the virtual world which typically follows the type of behaviour a user is used to when navigating a real 
world environment. Once the path has been calculated a spline is generated to further interpolate and 
hence to smooth the journey still further. In the present embodiment, once the spline has been 
generated along a particular path, a default speed along the path is set. In the present embodiment 
this is set to vary between a fairly fast speed in areas of little interest and to a relatively lower speed 
35 around features of interest. Ideally this is done by smoothly varying the speed to have minimum 
values at the feature nodes of most interest and to have maximum speeds in between these points. 

Although in the embodiment above, the node density criteria is specified in terms of the minimum 
40 allowed distance between a new node and an already existing node, this could be replaced by any 
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other suitable mechanism for specifying and testing the node density. Another possible method is to 
specify in advance a maximum allowed number of cycles of subdivision before the algorithm must 
terminate. 

5 Although In the embodiment above, the check for whether a new node is valid involves checking 
whether the node acts as a bridge between two other nodes, an alternative/additional criteria which 
may be used to define whether each newly added node is valid is to check whether the new node 
assists in providing a shorter path between any pair of nodes. 

10 Pathfinding 

As mentioned earlier, the A* algorithm is an optimal pathfinding algorithm both in terms of the 
processing time required, and the quality of the path found. Start and destination nodes are defined in 
advance, and the algorithm explores multiple different paths to find the best route from the start to the 
destination. Consider the case of a user who wishes to tour through virtual world 20, entering at door 
15 22, and who has indicated via a suitable interface that he desires to approach information board 25. 

The start node is defined as node 29A, and the destination node as 29G. The A* algorithm operates 
by maintaining two lists of nodes: a list of nodes that have already been explored (the Closed list) and 
a list of nodes linked to the ones that have been explored but have yet to be explored themselves (the 

20 Open list). The algorithm takes a node from the Open list, and if it is the destination node then the 
algorithm terminates. If not, all the nodes linked to the chosen node are added to the Open list. The A* 
algorithm is known as a heuristic method because it uses estimates to guide the search for nodes. In 
particular, in order to decide which node should be selected next from the Open list, all the nodes 
have an evaluation function f = cost + heuristic, and the node which is selected as the next current 

25 node from the Open list is the one with the lowest value for f. 

The cost is a measure of the quality of the path so far from the start node to the current node (i.e. for a 
simple A* algorithm this could be the sum of the lengths of all the links in the path between the start 
node and the node). The heuristic function is an estimate of the cost to get from the current node to 
30 the destination node. The results of the A* algorithm are very much dependent on the choice of cost 
and heuristic functions, and it is the specific weighting and cost values used in the evaluation function 
for the embodiment of the invention that allow the optimum path to be generated. 

The cost function of the embodiment takes into account various factors of the route, together with any 
35 user specific preferences. The cost function is a weighted sum of the following form: 

cost = w1 * distance + interest ^component + w3 * angle 

where distance is length of the links so far, and w1 is the weighting ascribed to the current user 
40 indicating how important it is to them that the path is as short as possible. lnterest_component gives a 
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measure of how interesting the node (s) so far have been (but since we are looking to minimise the 
cost function, the lower the interest_component value the more interesting the nodes so far have 
been). Thus, in the present embodiment a summation over the node or nodes included in the partial 
path built thus far of the form: 
5 £(l-M>2* Interest) 

PARTIAL _ PA TH 

is used, in which w2 is the percentage weighting interest given to the feature group associated with 
the node in question, and Interest is a measure of how strongly a node is associated with the 
corresponding feature associated with the node. Thus, in the present embodiment, feature nodes 

10 (typically of great interest to a user) may be given an Interest value 1, whilst navigational nodes have 
interest value of 0 and therefore when summed as above give a higher cost. As mentioned, weighting 
w2 gives a measure of how important it is to the user that they visit features of interest of each 
respective feature group. Finally, angle gives a measure of how much the path so far wiggles, since 
this represents a sum (or average) of how much the angle between the entry and exit links for each 

15 node deviates from a straight line. Weighting w3 gives a measure of how important it is for the user 
that the path wiggles as little as possible (i.e. a zero value of w3 would suggest that the user did not 
mind how wiggledy the path was whilst a high value (e.g. 100%) would indicate that the user would 
prefer to avoid wiggledy paths). This is shown in more detail in Figures 14A to 14C of the 
accompanying drawings. 

20 

In Figures 14 A; 14B, 14C a connection between nodes A and C is established via node B with varying 
degrees of efficiency. The LoS h between nodes A and B defines an initial reference angle fa = 0°. 
The LoS l 2 between nodes B and C subtends angle $ 2 from reference angle fa. 

25 Thus in Figure 14A, the LoS route between nodes A and B has A<|> = 4> 2 - fa = 0°, which provides the 
maximum efficiency, in contrast, the connections shown in Figures 14B and 14C are less efficient. In 
Figure 14B, A<|> = (j> 2 - fa < 90°, whereas in Figure 14C, A$ = fa - <h = 0°, = <t> 2 - fa > 90°- If the angle of 
differential is constrained to A§ < 90°, then the node connection shown in Figure 14B would be 
available, whereas that shown in Figure 14C would be inefficient. 

30 

According to one embodiment of the invention, the LoS angle differential A<|> between the entry LoS h 
and the exit LoS l 2 , provides an additional weighting for the pathfinding system described herein. The 
LoS angle differential can also be used to constrain pathfinding in other systems in which it is 
advantageous if connections between nodes are constrained according to whether a path is to be 
35 more or less "wiggly". 

In the embodiments shown in Figures 14A to 14C, if the LoS angle differential value A* is assigned a 
highest for A§ = 0° and a Acf> = 180° is assigned a low rating, the path finding system will optimise 
straight connections between nodes A and C. if however, A<|> = 0° had the lowest rating and A<f> = 90°, 
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for example, the path finding system would find more bendy paths acceptable. This is shown 
- schematically in Figures 15A and 15B. 

In Figure 15A a relatively straight path is shown between navigational nodes A and C t whereas in 
5 Figure 15B, a more wiggly path between navigational nodes A and C is shown. The path shown in 
Figure 15A is representative of a weight being provided by the LoS angle differential which constrains 
the path generation to optimise LoS connections between the nodes along the path. In contrast, the 
path shown in Figure 15B is representative of a weight being provided by the LoS angle differential 
which is representative of a weight being provided by the LoS angle differential which constrains the 

1 0 path generation to generate a wiggly path between nodes A and C. Thus, in the examples shown in 
Figures 14A to 14C, as the angle between the first and second line increases, the efficiency of the 
nodal connection decreases. The rating for each node is processed for .the entire path, for example, 
to determine an average rating for the path which will be dependent on the number of nodes along the 
path, to determine a line of sight (LoS) angle differentia! ranking value for each different nodal path 

1 5 between two points. 

Whilst the angle differential LoS weighting may be used by a content designer, it is also useful to 
provide a means for a user of the navigation system to apply a constraint on the angle differential LoS, 
as this can facilitate the user's orientation as they navigate the virtual environment. 

20 

Accordingly, another embodiment of the invention provides a user interface arranged to implement an 
angle differential navigation constraint. The user interface enables a user to constrain the LoS angle 
differential ranking value of the path in dependence on one or more preferences determined by the 
user. This enables a straighter guided path to be provided along which the user is automatically 

25 navigated according to the pathfmding system employed. This can enhance the user's experience as 
the user is able to retain more of a sense of direction. Moreover, by constraining the angle differential 
of the LoS of the guided path along which the user is automatically navigated by the system, the FoV 
that the user can also be constrained to enable the user to be less disorientated by the number and 
approach taken towards certain feature nodes. If more bendy automatic path navigation is selected 

30 by the user, then the more bendy path would enable the user to see more features from different 
directions possible, and even loop around certain features. This may be advantageous if a user has 
already navigated a path from A to C for example such as is shown in Figure 15A and now they are 
familiar with the topology of the virtual world wants to be automatically navigated from A to C but see 
more sights along the way. As the user is more familiar/better able to cope with the virtual 

35 environment (for example, a path may be more wiggly if an adult is exploring than if a very young child 
is exploring), the user is able to retain their sense of orientation despite several changes in direction 
and a more wiggly path can be followed if the user assigns a relatively high LoS angle differential 
ranking for the navigational nodes along the guided path. 
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Such a constraint can also be implemented using the user profile described in more detail later below. 
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The heuristic is an estimate of the cost to get from the current node to the destination node, and one 
possible choice for this is: 

5 heuristic = euclidian_distance_to_destination 

The heuristic in the embodiment is therefore based on the Euclidian distance to destination (i.e. a 
straight line from the current node to the destination node), although it could alternatively also include 
some measure of the distance, interest and angle weightings w1 , w2 and w3 if desired. 

10 

The system therefore runs through the A* algorithm for the nodes using the evaluation function, until 
the final destination node is reached. Importantly, the weightings w1, w2, and w3 can be varied 
depending on the user profile. 

1 5 Defining a user profile 

A suitable interface (not shown) allows the user to define their profile (e.g. what they are particularly 
interested in, and how they like to navigate through the virtual world). The user profile settings are 
then incorporated into the weightings above used for the A* algorithm, which consequently will result 
in different paths being generated for different users. The translation of the user interests into 

20 weightings allow different routes to be compared against each other such that the optimum path for 
that user can be generated. It can be seen that for a user who is particularly interested in visiting 
features of interest (paintings, landmarks, etc) it is likely to be the case that the system will not 
calculate the quickest or shortest route between two points. Rather, the lowest cost path (i.e. the best 
route for that user) will be one which visits as many features of interest as possible. 

25 

The user may input their profile upon first entering the virtual world. Some options include: 



Always select shortest path 


on / off 


Always select quickest path 


on / off 


Ignore all features 


on / off 


Gaze orientation 


on / off 


Velocity control 


on / off 


Importance of path being short (w1) 


weighting 


Importance of path not being wiggly (w3) 


weighting 


Importance of visiting Feature Group 1 [e.g. paintings] (w2) 


weighting 


Importance of visiting Feature Group 2 [e.g. information points] (w2) 


weighting 


Importance of visiting Feature Group 3 [e.g. landmarks] (w2) 


weighting 



30 The first five options are overrides, and are thus non-weighted. For example, if the user selected 
"Always select shortest path" as ON, then the weighting w2 for the features of interest become 
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irrelevant and will be set to zero. 

The final five options are all weighted, and however the weightings are distributed they should all be 
normalised (e.g. add up to 100% in total). Any option which is not important to the user and not given 
5 a weighting is deemed irrelevant and not taken into account in the pathfmding process. 

Dynamic Navigational Nodes 

In addition to the fixed navigational nodes (29A, 29B,~29C, etc), defined initially .by the content 
provider, the system may also include dynamic navigational nodes (not shown). These nodes operate 
10 like navigational nodes in the sense that they can form part of the path generated for the user, but 
provide enhanced functionality because the user is able to move them. A dynamic navigational node is 
associated with an interactive mesh object in the virtual world environment that can be moved around 
by the user. The user is able to specify that they want the dynamic navigational node to be a 
destination point, and the path will be calculated to it's location. 

15 

If a dynamic navigational node is placed a large distance from other navigational nodes, then the 
subdivision process described earlier may be used to fill in new nodes until a suitable node density is 
achieved in that area. This then allows a smooth path to be calculated to the node. 

20 If a dynamic navigational node is placed without a line of sight to any other navigational nodes (i.e. in 
a blind spot) then the node is defined as invalid - lost from the Node Matrix (although still present in 
the environment) and the user is prevented from selecting it as a destination. Alternatively, the system 
may prevent the user from placing the node in a blind spot, and only allows it to be moved into valid 
positions. 

25 

Switch Navigational Nodes 

In addition to the fixed navigational nodes and the dynamic navigational nodes, the system may also 
include switch navigational nodes (not shown), defined by the content producer. As mentioned earlier, 
navigational nodes have a Level ID, specifying which level the node belongs to, and effectively 

30 grouping the nodes into different subsets for more efficient path calculation. For example, if the virtual 
world consists of two different rooms, then the navigational nodes in one room may be defined as 
belonging to one level, and the navigational nodes in the second room to a different level. During the 
pathfinding process in one room, only the nodes of that level are evaluated, saving takes into account 
nodes on a different level. The switch nodes then provide the functionality to swap from one level to 

35 the second level (e.g. the switch navigational node might be positioned in a doorway between the two 
rooms). 

Associated with each switch navigational node is the following data set: 



Node ID 
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Node Level ID #1 
Node Level ID #2 
XYZ position 
LoS data 
Switching data 



Node ID - an identifier for the node 
Node Level ID #1 - the identifier for the first level 
Node Level ID #2 - the identifier for the second level 
5 XYZ position- these are the x, y, z co-ordinates giving the location of the switch navigational node 

LoS data - this gives the data for all nodes (for both levels) which the present node has Line of Sight 
(LoS) to 

Switching data - gives the criteria of when the generated path can / cannot switch from navigational 
nodes on one level to nodes on the other level 

10 

Event Feature Nodes 

As described earlier, the content provider is able to define feature nodes (28A, 28B, 28C, etc) 
associated with the features of interest in a virtual world. The content producer is also able to define 
event feature nodes (not shown) which have the extra functionality that they react to users within the 
1 5 virtual world, or are only active at certain predefined times. 

These event feature nodes expand the functionality of the system into the gaming and interactive 
online environment platforms, where multiple users can interact with the environment and with each 
other (e.g. the Event Feature may simulate an explosion, or the opening and closing of an interactive 
20 chat-room / race event. The content provider must specify when the event feature will be active / 
inactive, or what triggers it will respond to. An example data set is as follows: 



Node ID 

Feature Group ID . 

Trigger data 

XYZ of pivot point data 

Sphere of influence settings 

Time settings 

Display settings 



25 Node ID - an identifier for the node (e.g. text string "explosion") 

Feature Group ID - an identifier for the type of feature associated with the node 
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Trigger data - the conditions that will cause the event feature node to become active 

XYZ of Pivot Point Data - these are the co-ordinates giving the location of the event feature node 

5 Sphere of influence settings - these define (for a 3D world) a three-dimensional sphere surrounding 
the feature node. However, in addition to the settings used for the standard feature nodes, these 
additionally include a time dependant feature that may allow the sphere of influence to degrade over 
time. 

1 0 Time settings - these define when the event feature node will be active / inactive 

Display settings - these are the settings to be used for text / images associated with the feature when 
constrained 

Further functionality 

15 As explained above, the processing and pathfinding stages result in a spline path that will be used to 
take the user through the environment The spline path therefore comprises a plurality of nodes each 
joined by links to the next node. The system applies smoothing to this path by interpolating the spline 
so as to improve further the user experience. 

20 During real time display, when the user is guided through the environment they have the further option 
to control their field of view. As discussed earlier, the content provider can specify particular angles of 
viewing (FoV constraints) which are to be applied for specific feature nodes so as to ensure the user 
does not miss features of interest. The user can choose to toggle control to either operate this 
automatic field of view presentation or alternatively to control manually their own field of view. 

25 

In the embodiments described above, it is explained that the processing stage which creates the more 
dense matrix of nodes occurs after the content provider has defined the contents within a virtual world, 
but before the system is used by a user desiring to navigate within that world. It is of course 
alternatively possible for either part or all of the processing stage which adds these subdivided nodes 

30 to be carried out in real time whilst the system is in use by a user. Indeed, an alternative arrangement, 
is particularly desirable when the virtual world contains a number of dynamically moving objects (for 
example, a virtual environment of a city might include moving cars, buses, etc). In this dynamic case, 
only some subdivision (for the static objects such as buildings, etc) could be carried out in advance 
before a user accesses the system, with the remaining processing to add the extra nodes occurring 

35 each time a user specified that they desire a path to be created. The processing stage thus takes into 
account the positions of these dynamic objects at the instant the user desires the path to be created. 
This functionality could be supplemented by defining some regions in the world in which this 
subdivision will occur (for example, streets within a virtual city), and other regions in the world when 
the dynamic subdivision will not occur because they contain only stationary objects (for example, the 

40 insides of some buildings). This is a typical example when switch nodes (mentioned above) are used 
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to delimit the different regions. 

Furthermore, it may be necessary in real time to create new nodes corresponding to the start and 
destination points selected by a user for a path generation procedure. If nodes do not already exist at 
5 these locations then the system may be used to automatically create such nodes, and additionally use 
processing to add new subdivided nodes in only the regions close to the start and destination nodes 
so as to link them to the already existing node matrix. 

This invention enables the overall ranking for each prospective node path from the start to the 
10 destination points of a guided path to incorporate a rating based on the LoS Angle Differential. The 
LoS Angle Differential rating is first normalised, however, to enable the weighting indicated in a User 
Profile to influence the path ratings. After the set values within a VW have been weighted against the 
user settings the actual path rating calculation is performed. 

15 The LoS Angle Differential also enables the content producer of a VW to manually define constraints 
to the LoS angle between nodes to crop the angles which are searched for node partners without the 
need for a collisionable mesh, such as is shown in Figure 16A. 

Figure 16A shows a navigational node for which a valid LoS angle to or from another node is 
20 constrained to a range of angles between 0° and 9°, where 9 < 360° (9° = 360° would remove the 
range constraint for the LoS angle between nodes. 

This functionality allows the creation of channels of nodes that ignore other nodes around them which 
produces a break in the node matrix where links are not desiredFigure 16B shows how this may 
25 modify the LoS between two navigational nodes A and D, so that instead of a path being generated 
along a LoS connection between A and D, the pathfinding system instead generates a path via 
navigational nodes B and C. Navigational node B is positioned within the range of exit angles for 
navigational node A, whereas navigational node C is positioned between the range of entry angles for 
influence of node D. 

30 

It is possible for a node to have both a range of entry angles (and "entry cone") and a range of exit 
angles (an "exit cone")such as Figure 17 shows for node B. . An additional LoS constraint allows the 
content producer to create a first LoS "cone" which defines a range of angles that the first LoS line to 
the previous node on the path must enter through, and a second LoS "cone" which defines a range of 
35 angles through which a second LoS to the next node along the path must exit the node. 

In Figure 17, the pathfinding system is generating a path between nodes A and C, and node B is 
constrained in that it can form connections only with nodes within its entry and exit cones. Thus in 
Figure 17, the LoS between node A and node B falls within the entry cone for node B. Similarly the 
40 LoS between node B and node C falls within the exit cone for node B. However, the LoS between 
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node D and node B and the LoS between node B and node E lie outside the range of permitted 
approach and exit angles for node B. Accordingly, the dashed lines between nodes D and B and B 
and E are invalid connections. 



5 The LoS constraint shown in Figure 17, can be implemented as a modified version of the LoS Angle 
Differential constraint/weighting system described herein above with reference to Figures 14A to 14C 
and 15A and 15B of the accompanying drawings. For example, the range of angles of a second LoS 
cone (exit cone) is determined as a function of the LoS Angle Differential and the range of angles of a 
first LoS cone (entry cone), or vice versa in some embodiments of the invention. 

10 

Whilst the above embodiment of the invention has been described in the context of a pathfinding 
system suitable for plotting a guided path along which a user is automatically navigated in a virtual 
environment, the implementation of applying a weight to a pathfinding system which is based on the 
extent to which the path bends can be used in other systems in which a user wishes to plot a path, for 

15 example systems which enable the user to navigate across land and/or sea environments. In 
particular, where a user is implementing a system using global positioning satellite technology or the 
like, especially where the environment enables the user can determine a path which follows a 
relatively unconstrained route, the invention can be used to provide the user with a scenic route (for 
example, one which meanders across a desert or island-hops in a sea-environment) or a direct route 

20 (which might be more efficient in terms of fuel economy). 

Those skilled in the art will appreciate that the scope of the invention is determined by the appended 
claims, and that where a feature known to those skilled in the art is an apparent equivalent of a feature 
described herein, a feature described herein should be interpreted as synecdoche for all equivalent 
25 features. The features described herein with reference to particular embodiments may be combined 
with any particular aspect and with other features in any appropriate manner apparent to those skilled 
in the art. 
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CLAIMS 

1 . A method of determining a path along some of a plurality of points in a representation of an 
5 environment, the representation comprising a plurality of initially defined points, and obstructions 

through which the path cannot pass, the method comprising: 

(a) defining a plurality of additional points by repeating the following step: 

defining a new point located between a first existing point and a second existing point, 
wherein a first line between the first point and the new point and a second line 
10 between the new point and the second point do not pass through any of the 

obstructions; and 

(b) calculating the path based on any combination of new and/or initially defined points, 
wherein the angle of deviation of the first line to a line between the first and second points is 
constrained. 

15 

2. A method as claimed in claim 1, wherein the constraint is imposed by assigning a varying 
angle of deviation cost value in dependence on the angle to which the first line deviates from the 
second line. 

20 3. A method as claimed in claim 1, wherein the angle of deviation cost value is zero when said 

angle is 180 degrees, and said angle of deviation cost value is a maximum when said angle is 360 
degrees. 

4. A method as claimed in any previous claim, wherein the environment comprises a virtual 
25 world. 

5. A method as claimed in any previous claim, wherein the representation models a real world 
navigable environment. 

30 6. A method as claimed in claim 5, wherein the navigable environment comprises a sea-based 

environment. 

7. A method as claimed in claim 5, wherein the navigable environment comprises a land-based 
environment. 

35 

8. A method as claimed in any preceding claim, wherein the angle of deviation is constrained to 
a predetermined range. 

9. A method as claimed in claim 8, wherein the range of the angle of deviation is determined as 
40 a function of a range of angles within which the first line approaches the new point from the first point, 
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and a predetermine angle of deviation. 

10. A method as claimed in any claim dependent on preceding claim 4, wherein said method is 
performed to create the content of the virtual environment. 

5 

11. A method as claimed in any claim dependent on preceding claim 4, wherein said method is 
performed after the content creation of the virtual environment to dynamically determine the path. 

12. A method as claimed in any preceding claim, wherein said path determined has a 
10 dynamically changing destination node. 

13. A method as claimed in any claim dependent on preceding claim 4, wherein said path 
determined defines a field of view of said virtual environment. 

15 14. A system for determining a path along some of a plurality of points in a representation of an 

environment, the representation comprising a plurality of initially defined points, and obstructions 

through which the path cannot pass, the system comprising: 

processing means to define a plurality of additional points by repeatedly defining a new point 

located between a first existing point and a second existing point, wherein a first line between the first 
20 point and the new point and a second line between the new point and the second point do not pass 

through any of the obstructions; and 

processing means to calculate the path based on any combination of new and/or initially 

defined points, wherein the angle of deviation of the first line to a line between the first and second 

points is constrained. 

25 

15. A system as claimed in claim 14, wherein the system further comprises means to enable a 
user to be automatically navigated along said path. 

16. A system as claimed in any one of preceding claims 14 or 15, wherein the system further 
30 comprises means to enable a user to select the degree to which said path is wiggly. 

17. A user interface for a navigational system as claimed in 16, wherein the user interface is 
arranged to provide said means to enable the user to select said degree to which said path is wiggly. 

35 18. A storage medium carrying computer readable code representing instructions for causing 
one or more processors to perform the method according to any of claims 1 to 13 when the 
instructions are executed by the processor or processors. 

19. A computer program comprising instructions for causing one or more processors to perform 
40 the method according to any of claims 1 to 3 when the instructions are executed by the processor or 
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processors. 

20. A computer data signal embodied in a carrier wave and representing instructions for causing 
one or more processors to perform the method according to any of claims 1 to 3 when the instructions 

5 are executed by the processor or processors. 

21. A storage medium carrying computer readable code representing instructions for causing 
one or more processors to operate as the system according to any of claims 14 to 16 when the 
instructions are executed by the processor or processors. 

10 

22. A computer program comprising instructions for causing one or more processors to operate 
as the system according to any of claims 14 to 16 when the instructions are executed by the processor 
or processors. 

1 5 23. A computer data signal embodied in a carrier wave and representing instructions for causing 
one or more processors to operate as the system according to any of claims 14 to 16 when the 
instructions are executed by the processor or processors. 
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ABSTRACT 

ANGLE DIFFERENTIAL CONSTRAINED PATHFINDING SYSTEM 

A method of determining a path along some of a plurality of points in a representation of an 
environment, the representation comprising a plurality of initially defined points, and obstructions 
through which the path cannot pass. The method comprises defining a plurality of additional points by 
repeating the following steps: defining a new point located between a first existing point and a second 
existing point, wherein a first line between the first point and the new point and a second line between 
the new point and the second point do not pass through any of the obstructions; and calculating the 
path based on any combination of new and/or initially defined points, wherein the angle of deviation of 
the first line to a line between the first and second points is constrained. 



[Figure 14B] 
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